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ABSTRACT 



Two Extended Kalman filter routines, one using a one-step 
estimation/prediction and the other a sequential approach, 
were developed and compared to provide real time estimates 
of target positions on the three dimensional underwater track- 
ing range at Naval Underwater Weapons Engineering Station, 
Keyport, Washington. Inputs to the routines were acoustic 
pulse transit times from the target to receiving array ele- 
ments which are non-linear functions of the position coordin- 
ates. These inputs were linearized and the filter gains cal- 
culated on-line. Simulated runs were conducted for tracks in 
the area of one hydrophone array and for tracks than transited 
through multiple arrays . It was found that the sequential 
estimate routine exhibited better performance in recovering 
from transients caused by random measurement noise or target 
movement . 
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INTRODUCTION 



I . 

The Naval Underwater Weapons Engineering Station, Keyport, 
Washington currently operates two three-dimensional under- 
water tracking ranges with the capability of acoustically 
tracking torpedoes. Underwater tracking employs an acoustic 
device installed in the object to be tracked. This device 
transmits timed acoustic pulses which are received by bottom 
mounted hydrophone arrays and then relayed via cable to a 
computer at the observation site which calculates the position 
of the object for each pulse and plots its path. 

The measured data, which is the time elapsed from trans- 
mission of a pulse until its receipt at the hydrophone array, 
is corrupted by noise due to the combined effects of environ- 
mental factors and the measurement instruments. 

These noisy tracks are later analyzed, and measurements 
judged most inaccurate on the basis of total track statistics 
are removed in order to obtain a smooth representation of the 
track . 

As stated in Reference 1, the computer system at the 
Dabob range of the station will be up-graded, and will consist 
of three MODCOMP IV computers by DATACOM, Inc. A software 
conversion project will take place with applications software 
being developed for the new computers. The bulk of this 
development will consist of converting the current tracking 
programs and other related programs to FORTRAN. 
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An opportunity exists for expanding the real-time capa- 
bility of the system by applying a Kalman filter routine 
which can take as an input the transit times of the acoustic 
pulses, and produce the best estimate of the position of the 
tracked object at a particular time. 
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II. THREE DIMENSIONAL RANGE DESCRIPTION 



The three dimensional range described in Reference 2 is 
an acoustic system capable of determining the trajectory of 
suitably instrumented underwater objects in the vicinity of 
a transducer array placed at the bottom of the bay. The 
tracked unit (torpedo) carries a synchronous clock and an 
acoustic transducer. A hydrophone array defines a rectan- 
gular coordinate system to which measurements are referred. 
Positional information is obtained from the transit times of 
a periodic pulsed acoustic signal traveling from the torpedo 
to four independent hydrophones located on each array. The 
geometry of the hydrophones and the coordinate - system is 
illustrated in Figure 1. On each array, the four hydrophones 
R c , R x , R^. and R z are on four adjacent vertices of a cube. 
Each hydrophone is separated by a distance d= 30 feet along 
the edges. The origin of the coordinate system is at the 
center of the cube . 

The transit times of the acoustic pulse from the tracked 
object to each of the four independent hydrophones can be 
expressed as follows: 



T c = 1/VEL 



(X+d/2) 2 + (Y+d/2 ) 2 + (Z+d/2) 



*5 



T 



X 



1/VEL 



(X-d/2 ) 2 + (Y+d/2) 2 + (Z+d/2) 2 
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X 



FIGURE 




1: The Geometry Used in the Calculation 
of Positional Coordinates (The origin 
is at the center of the dashed cube). 
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T y = 1/VEL 



(X+d/2 ) 2 + ( Y-d/2 ) 2 + ( Z+d/2 ) 2 






T Z 



1/VEL 



(X+d/2) 2 + (Y+d/2) 2 + (Z-d/2) 2 



h 



Where VEL equals the velocity of propagation of sound in 
water and C, X, Y and Z are the four hydrophones on each array. 
It is essential as part of this fundamental calculation to 
know when the tracked object emits an acoustic pulse in order 
to measure the transit times to the hydrophones. For submerged 
objects two stable crystal-controlled clocks, one in the track- 
ed unit and the other at the computer are used. Prior to a 
run the two clocks are synchronized by radio. 

The range is a high frequency, short-baseline facility 
with the acoustic tracking pulses emitted at 75 kHz . The 
range layout consists of six in-line hydrophone arrays spaced 
2000 yards apart. 
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III. THEORY 



In Reference 3, a Kalman filter application was used 
assuming a linear system and filtering on the corrupted X, Y 
and Z positions that the computer had already calculated from 
the received transit times of the acoustic signals. 

A. THE EXTENDED KALMAN FILTER 

Since the transit times were readily available and are non- 
linear functions of position, these equations can be linearized 
and Kalman filter theory applied using the extended Kalman 
filter. This procedure produces a real-time system, filtering 
on the corrupted transit times T , T^, T^ and T^/ without the 
necessity of converting these times to positions. 

For tracking, a fifth order state vector was chosen: 

X = 

The target was assumed to maintain constant depth and any 

* 

velocity in the Z direction (Z) was considered a random exci- 
tation. 

The states were characterized by the following difference 
equation : 

X (K+l ) = $ X (K) + T W (K) 
and the noisy measurement equation: 
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where 



Wh0IT0 


7. (K) = M(X) + V (K) 


X(K) 


is the N-dimensional state vector at time K 


W (K) 


is the M-dimensional random forcing input 
at time K 


Z(K) 


is the J-dimensional measurement vector at 
time K 


V(K) 


is the J-dimensional random noise vector at 
time K and noise is assumed white and zero- 



mean Gaussian 

$ and r are constant matrices 



M ( X) 


is a matrix of the non-linear measurement 
equations which are a function of the states. 



The estimator equations are given by: 



X (K/K) 


= X (K/K-l) + G (K) * Z(K) - M(X) *X(K/K-1) 


and 




P(K/K) 


= I - G(K)H(K) P (K/K-l) 


where 




X (K/K) 


is the estimate of the state at time K given 
K measurements 


P (K/K) 


is the covariance of estimation error matrix 
at time K 


G(K) 


is the Kalman filter gain at time K 



which is defined as: 



-G(K) = 


P (K/K-l) H(K) T H(K)P(K/K-1)H(K) T + R(K) _1 


R(K) 


is the covariance of random measurement noise 
matrix 


H(K) 


is the matrix used to linearize the non-linear 
measurement equations. It is defined as: 
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H(K) 



_ 3M ( ~ ) 
3X~ 



X (K/K-l) 



,X, 



The measurement equation matrix M(~) is expanded in a 
Taylor series and linearized around the one step prediction 
based on the last 'estimate . Only first order terms are kept. 
The prediction equations are given by: 



where 



X (K+l/K) = 4>X (K/K ) + T W(K) 

P (K+l/K) = $P(K/K)$ T + Q (K) 



Q(K) is the covariance of random excitation 
matrix found by: 

q (k) = r cov(w)r T 

and COV(W) is the covariance of the random 
forcing input or acceleration. 



B. THE SEQUENTIAL EXTENDED KALMAN FILTER 

The prediction and estimation equations just mentioned 
represent a system that is characterized by a one-step esti- 
mation and prediction for each set of new measurements. Some 
important points in this one step process must be stressed: 

1. New estimates are only available after the prediction 
and estimation equations are calculated. 

2. A major part of the time period for the estimation 
calculation is spent in the gain equation because of 
the inversion of the (JXJ) matrix that is required, 
where J is the number of observations. 



14 



3. The one-step prediction and estimation for the exten- 
ded Kalman filter is based on a linearization about 
the predicted value over a period t R to which 

might be extended. 

When the measurements come from statistically independent 
sources, like the hydrophones in the torpedo tracking pro- 
blem, a sequential approach can be taken to process each 
arrival time separately. 

If the measurements are assumed to occur simultaneously, 
they can be processed one at a time and the result of pro- 
cessing one measurement component is used in the following 
computation to process the next measurement component. 
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IV. PROBLEM DEFINITION - TORPEDO TRACKING WITH THE 
EXTENDED KALMAN FILTER 



In the torpedo tracking problem, the non-linear observa- 
tions are the four independent transit times from the tracked 
object to the hydrophones, T c , T^, T^ and Thus the non- 

linear measurement matrix M(X) is defined as: 



M(X) 




T 



Z 



1 

VEL 

1 

VEL 

1 

VEL 

1 

VEL 



(X+d/2 ) 2 + ( Y+d/2 ) 2 + ( Z+d/2) 2 
(X-d/2 ) 2 + (Y+d/2) 2 + (Z+d/2) 2 
(X+d/2) 2 +(Y-d/2) 2 + (Z+d/2) 2 
(X+d/2) 2 +(Y+d/2) 2 +(Z-d/2) 2 ! % 



M(X) is expanded into a Taylor series and linearly approximated 
by : 



M (X) 



3M(?) 

3X 



X 

X (K/K-l) 



H(X) 



X 

X (K/K-l) 



The linearizing H matrix is evaluated around the best 
information available at the time which is the prediction 
X (K/K-l ) , and is used in the calculation of the gain G(K) and 
estimated covariance of error P (K/K) equations. 

The torpedo dynamics used for the tracking problem are 

2 • • 
assumed to be 1/S with extimations on five states X position, 
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X velocity, Y position, Y velocity and Z position (height of 
torpedo above hydrophone array) . The mean of the random ex- 
citation is assumed to be zero (W (K) ) =(Tj , and this simpli- 
fies the estimate prediction equation to: 



X (K+l/K) = <S> X (K/K ) 



Also the mean of the random ncise is assumed to be zero 
J^E (V (K) ) =oj . In forming the measurement equation, the best 
guess of v(K) is used which is the mean producing: 

Z (K) = M ( X) 

Four measurements are taken every 1.31 seconds, which is one 
time slot, and with this sampling time the l/g2 plant has 
state transition (PHI) and gamma matrices equal to: 



3> = 



1 

0 

0 

0 

0 



1.31 

1 . 

0 

0 

0 



0 

0 

1 

0 

0 



0 

0 

1.31 

1. 

0 



and 



r = 



.86 

1.31 

0 

0 

0 



0 0 

0 0 

. 36 0 

1.31 0 

0 1.31 



0 

0 

0 

0 

1. 









A. THE SEQUENTIAL APPROACH 

In the sequential approach, the basic Kalman filter equations 
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have been modified to circumvent the matrix inversion in the 
gain equation and to obtain a more accurate estimate. Calcu- 
lations are performed on each of the four independent transit 
times in the following order T , T x , and T z for each 1.31 
second time slot. 

A 

The estimate of the states, X(K/K), based on one time 

A 

measurement is used as the prediction X(K/K-1) for the calcu- 
lations on the next measurement. 

In this manner only parts of the linearizing H matrix and 
gain matrices are used in each calculation. 

After the linearizing H matrix is formed from 



X (K/K-l ) 

/N 

evaluated around the initial states X(l/0) for K=l, the first 
gain column corresponding to the first time measurement is 
calculated from: 



H (X) = 



9M (?) 
3X 



?iCOL 



? (K/K - 1)f ?iROW 



?iROW? (K / K - 1)H iROW +R ii 
where i = 1 to J, and J is the number of observations. In 
the tracking problem J = 4 corresponding to the four measured 
times . 

Thus, the first row of the H matrix is used to calculate 
the first column of the g$in matrix with both corresponding 



to the first measured time T^. 
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/\ 

Next, an estimate of the particular observation time M( 
is calculated 



M ( X) 



A 

T c 




1 

VEL 


(X+d/2 ) 2 + (Y+d/2 ) 2 + ( Z+d/2) 




A 

T 

x 




1 1 
VEL ! 


[jX-d/2) 2 + (Y+d/2) 2 + ( Z+d/2) 2 




A 

T 

Y 




-1_ 1 
VEL 


Qx+d/2) 2 + (Y-d/2) 2 + (Z+d/2)" 2 ] 


1 " 


A 




1 

VEL 


(X+d/2) 2 + (Y+d/2) 2 + (Z-d/2) 2 
_J 


1 h 

1 

1 



Using the predicted values of X, Y, Z from X(K/K-1) . 

The difference between the observed transit time Z . and 

1 

A 

the estimated transit time T . forms the residual which 

l DIFF 

is used in the estimate equation. 

X ± = X (K/K-l ) + G i COL Z DIFF 

This equation gives an estimate of the states based on 
one measurement. 

Next, the covariance of estimation error is calculated 
based on one measurement using: 



^DIFF_ 



P. = 
1 



I - 



G iCOL H iROW 



Vl 
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i x 



where 



I equals the identity matrix 

P._ 1 is the theoretical covariance of estimation 
error from the previous measurement or if 
i=l, the prediction P(K/K-1) 

After the first iteration, X^ becomes X(K/K-1) and P^ 

becomes P(K/K-1) for the second iteration which calculates 

the estimate of the states based on the second measurement 

V 

After four iterations (i=4) , becomes the estimate for 

✓\ 

the time slot, X(K/K) and P^ becomes the updated covariance 
of error P(K/K). 

Then the predictions for the next time slot are calcula- 
ted using: 

X (K+l/K) = <J> X (K/K) 

and 

P (K+l/K) = $ P(K/K)4> T + Q(K) 

The entire process is repeated for the next set of 
measurements forming a sequential, extended Kalman filter to 
produce real time estimates of the torpedo track. 

A listing of the FORTRAN program designed for the se- 
quential extended Kalman filter is contained in Appendix B, 

The program is in modular form and well documented by comments 
for ease of implementation. All repetitive calculations and 
utility routines are separated into subroutines and are listed 
in Appendix D. 
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B. THE MATRIX INVERSION APPROACH 



All results obtained using the sequential, extended Kalman 
filter were compared to results from a traditional extended 
Kalman filter using the equations delineated in the THEORY 
section. This includes an inversion of a 4x4 matrix in the 
gain equation. 



G (K) = P (K/K-l) H (K) 



H (K) P (K/K-l) H (K) T +R(K) | 1 



The portion of the equation to be inverted is always symmetric 
and the IBM- 360 library subroutine SINV was used to perform 
this operation. 

A listing of the FORTRAN program designed for the tradi- 
tional extended Kalman filter is contained in Appendix C. 
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V. TESTING AND SIMULATION 



Both the sequential and traditional Kalman filter routines 
were tested first using deterministic tracks at speeds of 5.0 
to 25.0 knots and no measurement noise with a single hydrophone 
array. The only errors allowed in the first phase of testing 
were in position and velocity in the initialization of the 
filter. 

Computer generated tracks were tested in the first series 
of straight running, constant depth and constant velocity 
torpedoes. A variety of track scenerios were used transiting 
through multiple quadrants including: 

1. crossing north of the array 

2. crossing south of the array 

3 . inbound to the array 

4. outbound from the array 

5. crossing over top of the array 

All runs were made with a variety of initialization errors 
in position and velocity. 

In the second series of tests, white, zero-mean Gaussian 
noise was added to corrupt the observed transit times , 

The noise was added to the straight running, constant 
depth tracks. Before this series of tests could be conducted 
a gating scheme was designed to protect the filter from spurious 
erroneous time or positional data. 

In the third series of tests, a number of torpedo maneuvers 
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were added to the target tracks. One-third, two-thirds and 
one-G turns were used. These tracks were tested with and with- 
out noise. 

The torpedo velocities were increased to the 40 to 50 knot 
range in the fourth series of tests for straight running tracks 
with and without noise corruption. Maneuvers were then added 
to these higher velocity tracks. 

In the last series of tests, the handoff routine described 
at the end of this section was added to the filters and tracks 
that traversed through the areas of multiple arrays were 
tested . 

A. THE GATING SCHEME 

The operation of the filter may be adversely affected by 
large measurement noise. One error of a relatively large 
magnitude could invalidate the filtered output for many sub- 
sequent time slots. Before random measurement noise and ran- 
dom excitations could be added to the observed times for test- 
ing, a form of protection was designed to guard against cata- 
strophic failure. This protection is provided by establishing 
limits of acceptability for each of the measurements. 

Measurement errors can occur because of many factors in- 
cluding an error in the transit time of the acoustic pulse 
primarily due to the receipt of multipath signals from previous 
time slots that have bounced off the surface, bottom or dif- 
ferent density layers, or large errors in the estimates of 
position or velocity. 
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A three-sigma gate was deisgned using the covariance of 
measurement noise (R) and the covariance of estimation error 



(P (K/K) ) . 



For each calculation of a state estimate (X(K/K)), the 
largest positional covariance of error was used, either X, Y 
or Z, and converted to time in seconds using the average velo- 
city of sound in water for Dabob bay, 4860 ft/sec. The gate 
then was written for each time measurement i = 1 to 4 : 



The gate expands or decreases depending on the confidence level 
of the transit time and position estimate. If ZDIFF which is 
the difference between the actual transit time received and 
the predicted transit time to a particular hydrophone exceeds 
the gate, the measurement is considered unacceptable and the 
filter gain is set to zero causing the filter to ignore the 
data and take the prediction of the states as the estimate. 



X (K/K) = X ( K/K-l ) 

For the sequential extended Kalman filter, because of the 
iterative aspect, a la,rge erroneous time measurement zeros 
only the gain column for that particular hydrophone causing 
only that hydrophone's data to be ignored. In the traditional 
one-step filter, an erroneous input from any hydrophone zeros 
the entire gain matrix causing the filter to ignore data for 



GATE 




P(K / K) largest 



4860. 




the whole time slot. 
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B. MULTIPLE ARRAY TRACKING 



Initial tests were performed on tracks in the area of one 
array. In order to more closely simulate a typical run on the 
range, a scheme was designed to track a target through multiple 



First, a coordinate system was defined as shown in Figure 
2. The center of the coordinate system is geographically near 
the entrance to Dabob bay in the simulation. Array number 6 is 
the closest array to the coordinate center. Each hydrophone 
is a particular array has an X, Y, Z position. In the simu- 
lation array 1 was at 36,000 feet from coordinate center and 
array 6 was 6000 feet. The C hydrophone was assumed to be the 
axis location of each array. Then each X position for the X 
hydrophone in each array was X^+30, each Y position for the Y 
hydrophone was Y^+30 and each Z position for the Z hydrophone 
was Z^+30. These 72 positions, an XYZ position for each of 4 
hydrophones in 6 arrays, were placed into a 6x12 matrix HYDRO 
and referenced throughout the routine. The geometry centered 
on each array was taken out of the problem and the target 
position was based on a central reference. 

The non-linear time equation became: 



where X^ , Yq or Z^ is the position of a particular hydrophone 
and array being used. In the filter routine X, Y and Z were 



the predicted positions X(I</K-1) , and the time equation was 



arrays 



T = 1/VEL 
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HYDRO — Hydrophone Location Matrix 
FIGURE 2 
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used to calculate the estimate of the measurement times M(X) . 
The decision parameter used to determine the switching from 
array to array was a straight handoff. If the predicted X 
position was greater than 3000 feet from the array in use, 
then an index (18) was incremented and the next row of HYDRO 
was implemented. This placed into the routine the x g Y g Z g 
positions of the hydrophones in the next array. The handoff 
can easily be utilized in real range operations, as the tran- 
sit times from adjacent arrays are present at the computer for 
a particular time slot. 

For simulation, it was assumed that in all the arrays each 
axis pointed in the same direction. In range operations, the 
positions of the particular hydrophones referenced to the 
central coordinate system can be input into the matrix HYDRO 
to correct for OFF AXIS discrepancies. 
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VI. SIMULATION RESULTS 



A. SERIES ONE 

This series of tests included straight running, constant 
depth, constant velocity tracks with no noise. Various target 
speeds were tested ranging from 5.0 to 25.0 knots. 

The only induced . errors in this series of tests were in 
initial target position and velocity. Both the sequential 
and traditional filter routines effectively handled initial 
position errors in the X AND/OR Y direction from 0 to 25 feet 
and initial velocity errors from 0 to 10 ft/sec. The filter 
estimate was within 3 feet and 1 ft/sec in a maximum of 3 
time slots. In a number of worst case tests, initial posi- 
tion errors of up to 50 feet and initial velocity errors of 
60 ft/sec and 80 ft/sec were used. Both filter routines had 
the estimate on track within seven time slots. 

Figure 3 is a geographical plot of a typical series one 
test using the sequential extended Kalman filter. The initiali- 
zation of the filter was 14 feet off in X and 21 feet off in 
Y with no error in Z. For a 25 knot target initial velocity 
errors were 3 ft/sec. Figures 4 through 6 depict the devia- 
tion in feet between the estimated and true positions, 

X a (K) - X (K/K) , where A = 1, 3 or 5. 

There was no great difference in performance between the 
sequential and traditional filter routines in this series of 
tests . 
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Geographic Plot Straight Running Track 
in the area of a single Array 



29 



*310.00 f 



C.J 17.30 55.00 32. 5C 110. CO 



306. 67 + 



303.33 + 



^ 300.00 

IN FT 



« 4-4-4- f4*+ 4- 

4- * i? 5 ;:* 35 * * .* « « « is x 85 £'**-*-** A # -tfit xtt ti 3i *tx: ■£ ■“.nzilr.illx *l f. Dt # * ■*■■* * ~: 1» *r X «A*..axx3w 

* 44 + 44 * 44+444 + +*+ +■ 



Z96. 67 + 



293.33 + 



290.00 + 



*. •*«-:;■*:* * *-{s a -f an *».**«■«-* .|.*# * * -t. 

0.0 :7. 50 

X-5CAL6: “f"* 0.138E Ol UNITS 

Y-SCALE: u « ,# a 0-333E OO UNITS 



K sc ■«;*+;« a :» *»j» 

55. 00 



s-K^uaa * f 

22 . 5 C 



no .c; 



TIME slots 



FIGURE 4: Z Position versus Time for a Straight Running 

Track with No Noise in the Area of a Single Array 



30 



X-DEV (FT) 



13. 57 



1.00 So .00 51.00 

«X J* *V 4- V 4t * fc**:fc*74-**<* ■** * *«4T 



76. CO 

«if *&****#&? m* * *.* A* m. 



Id. CO 

**«£*'V.«jra+s 



IC.97 ^ 



5.23 



5.5 a + 



: . 88 > 



0. 18 



-2.5Z 



+ * * <x » J J<r* T 

l.^J 26.00 

X-SCALEs U -4C* - 0.I.25E 01 UNi TS 

Y-SCALfs '•**** 0.170E 00 UWIT5 
DEVIATION FRO* TRUE X 



it -* « n ^ o 






51.00 



rs .jo 



1 Jl.OO 



TIME slots 



FIGURE 5 ’- X Deviation from True versus Time for a Straight 
Running Track without Noise in the Area of a 
Single Array 



31 



1.00 26.00 51. 0C 76.00 1C1.00 




-8-32 




-L 2. bb 



-L7.00 



- 21. 24 ♦ 



l.CC 



* ft sc 4 r 

26.00 



X* SCALE : "*"* 0.1256 01 UNITS 



51. 00 

TIME SLOTS 



£ ft ' tct ? 



76.00 



io.i. o: 



Y-SCAL6: 



0.4346 00 U W I TS 
DevlATI ON FROM TRUE Y 



FIGURE 6: Y Deviation from True versus Time for a straight 
Running Track without Noise in the Area of a 
Single Array 



32 



B . SERIES TWO 



In the second series of tests random white Gaussian noise 
was added to the transit time measurements for straight running 
tracks. Target velocities varied from 5.0 to 25.0 knots. Ini- 
tial position errors ranged from 0 to 25 feet and initial velo- 
city errors from 0 to 10 ft/sec. 

Both the sequential and traditional routines performed 
well against the random noise. Estimate deviations from true 
track in X and Y positions were not observed greater than 3 
feet after lock-on was acquired. Figures 7 and 8 depict the 
estimate deviation from true track for the sequential routine. 
Initial positions were 9 feet off in X, 13 feet in Y and 2 feet 
in Z . 

C. SERIES THREE 

In this series of tests maneuvers were added to the torpedo 
tracks and the filter was tested with and without noise. 

Figure 9 is a geographical plot of a 25 knot target in a 
noiseless environment with 1/3-G turns at time slots 25 and 65. 
Figure 10 depicts the Z position versus the time of run. In 
the initialization of the filter X was off 13 feet and Y was 
off 21 feet. Figure 11 depicts the deviation by the estimate 
from the true track in the X direction, for the traditional 
inversion approach. Figure 12 shows the deviation for the 
same track using the sequential extended Kalman filter. When 
the target initiated the turn at time slots 25 and 65, the 
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covariance of estimation error and thus the filter gains in- 
creased allowing more weight to be placed on the incoming 
data (transit times) . In this manner the filter was able to 
adjust the velocities in the X and Y directions and force the 
estimate back on track. Results from both routines were com- 
parable as is shown in Figures 11 and 12. The routine using 
the sequential extended Kalman filter deviated a maximum of 
four feet at the turn and was back on track within 3 time 
slots, while the traditional filter routine had a slightly 
greater deviation and required 2 more time slots to acquire 
lock again. Figure 13 shows the deviation of the estimate 
from true track in the Y direction for this same run for the 
sequential filter and Figure 14 for the traditional filter. 
Both estimates deviated a maximum of 3 feet at the turn and 
re-acquired lock-on in 4 time slots with the sequential rou- 
tine reacting slightly better to the turns. 

Next, target tracks with 2/3 and 1-G turns were tested. 
Figure 15 is a geographic plot of this track with a 1-G turn 
at time slot 25 and a 2/3-G turn at time slot 65. Figure 16 
depicts the Z position vs time for this track. With an ini- 
tialization error of 13 feet in X and 21 feet in Y, the maxi- 
mum deviation after lock-on was a,gain at the turn points. 
Figure 17 depicts this deviation from true track in the X 
direction, for the sequential, routine with a maximum deviation 
of approximately 5.5 feet for the 1-G turn. Lock-on was re- 
acquired in a maximum of 4 time slots. Figure 18 shows the 
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deviation from true in the Y direction with a maximum deviation 
after lock-on for the 1-G turn of under 4 feet. Runs with 
the traditional extended Kalman filter routine showed slightly 
larger deviations with more reaction time required to re-ac- 
quire lock-on. 

In the final tests for this series, zero mean, white Gau- 
ssian noise was added to corrupt the observed transit times. 
Figure 19 depicts the estimate's deviation from true track 
in the X direction using the traditional filter routine. The 
target experienced 1/3-G turns at time slots 25 and 65. Figure 

20 shows the same track in noise with the same filter parame- 
ters when run with the sequential extended Kalman filter rou- 
tine. Comparison shows that the latter had approximately 2 
feet less maximum deviation and that while the traditional 
routine had trouble re-acquiring lock-on after the turn, the 
sequential routine regained track within 4 time slots. Figures 

21 and 22 depict the same type of behavior for deviation in 
the Y direction. Maximum deviation again was slightly less and 
lock-on more efficiently re-acquired using the sequential rou- 
tine. 

In the cases involving more radical maneuvers, the se- 
quential routine continued to perform better against the mo- 
deled noise. Figure 23 shows the estimate's deviation from 
true track in the X direction for a run with a 1-G maneuver at 
time slot 25 and a 2/3-G maneuver at time 65 in noise. This 
graph for the traditional routine shows maximum deviation at 
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the 1-G turn of approximately 9 feet and the difficulty the 
filter had in re-acquiring lock-on. Figure 24, which is the 
same track and filter parameters run with the sequential rou- 
tine, shows a marked improvement in both maximum deviation and 
efficiency in re-acquiring the track after a turn in noise. 

Figures 25 and 26 demonstrate again the tetter performance 
of the sequential extended filter routine regarding deviation 
in the Y direction for tne more radically maneuvering track. 

D. SERIES FOUR 

In the fourth series of tests, the target speeds were in- 
creased to the 40 to 50 knot range in order to bring the simu- 
lation in line with speeds actually experienced on the range. 
In a noiseless environment, both routines showed similar per- 
formance with a maximum deviation from true track during the 
run under 2 feet. With random noise added this deviation in- 
creased and Figure 27 is a plot of the deviation in the X 
direction using the traditional routine. When compared to 
Figure 28 which is the same track using the sequential routine 
with the same parameters , a marked improvement in maximum de- 
viation and lock-on efficiency is noticeable. Better perfor- 
mance by the sequential routine was also present regarding 
deviation in the Y direction. 

When J/3-G turns were introduced, the routines performed 
similarly in a noiseless environment. With random noise and 
maneuvers the routines were again comparable with the tra- 
ditional routine performing slightly better as is shown in 
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FIGURE 23: X Deviation from True for a Track with 2/3-G 
and 1-G Turns with Noise in the Area of a 
Single Array — Traditional Routine 
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FIGURE 24: X Deviation from True for a Track with 2/3-G 
and 1-G Turns with Noise in the Area of a 
Single Array — Sequential Routine 
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FIGURE 25: Y Deviation from True for a Track with 2/3-G 
and 1-G Turns in the Area of a Single Array 
with Noise — Traditional Routine 
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FIGURE 26: Y Deviation from True for a Track with 2/3-G 
and 1-G Turns with Noise in the Area of a 
Single Array — Sequential Routine 
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FIGURE 27 : X Deviation from True for a Straight Running 
42 Knot Target with Noise in the Area of a 
Single Array — Traditional Routine 
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FIGURE 28: X Deviation from True for a Straight Running 
42 Knot Target with Noise in the Area of a 
Single Array — Sequential Routine 
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Figures 29 and 30. Figure 29 depicts the estimate's deviation 
from true in the X direction for the traditional routine and 
Figure 30 for the sequential. In this track the target man- 
euvered, using 1/3 -G turns, at time slots 25 and 65. A 
slightly better performance was also exhibited by the tradi- 
tional routine in the Y direction. 

In tests in which more radical maneuvers were made, the 
traditional routine again exhibited slightly better performance 
in noise. Figure 31, shows the deviation in the X direction for 
a track with a 1-G turn at time 25 and a 2/3-G turn at 65 using 
the sequential routine. Comparision with Figure 32, which is 
the same track using the traditional routine, indicates that 
the performances were similar with the traditional routine 
having a slight edge. 

E. SERIES FIVE 

In the last series of tests, the targets were tracked 
through multiple arrays using the handoff scheme described in 
the previous seciton. Figure 33 is a geographic plot of a 
typical track including hydrophone positions. Figure 34 de- 
picts the estimates deviation from true in the X direction 
using the traditional routine for a straight running target in 
noise. Figure 35 is the X deviation for the same track using 
the sequential routine. Through the multiple arrays, both 
routines were comparable, and the handoff from array to array 
was smooth with no glitches. Figures 36 and 37 also show com- 
parable results for deviation in the Y direction for this same 
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FIGURE 29: X Deviation from True for a Track with 1/3-G 
Turns at 42 Knots with Noise in the Area of a 
Single Array — Traditional Routine 
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FIGURE 30 : X Deviation from True for a Track with 1/3-G 
Turns at 42 Knots with Noise in the Area of a 
Single Array — Sequential Routine 
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FIGURE 31: X Deviation from True for a Track with 2/3-G 
and 1-G Turns at 42 Knots with Noise in the 
Area of a Single Array — Sequential Routine 
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FIGURE 32: X Deviation from True for a Track with 2/3-G 
and 1-G Turns at 42 Knots with Noise in the 
Area of a Single Array — Traditional Routine 
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FIGURE 33: 



Geographic Plot of a Straight 
Track through Multiple Arrays 
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FIGURE 3^: X Deviation from True for a Straight Running 
Track through Multiple Arrays with Noise — 
Traditional Routine 
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FIGURE 35: X Deviation from True for a Straight Running 
Track through Multiple Arrays with Noise — 
Sequential Routine 
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FIGURE 36 : Y Deviation from True for a Straight Running 
Track through Multiple Arrays with Noise — 
Traditional Routine 
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FIGURE 37*. Y Deviation from True for a Straight Running 
Track through Multiple Arrays with Noise — 
Sequential Routine 



68 



run. The target was traveling at 40 knots and handoff was 
accomplished at the following times : 
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VII. CONCLUSIONS 



Both extended Kalman filter routines designed will provide 
on-line, real time estimates of targets with various maneuvers 
up to 1-G turns . 

Implementation at the range computer facilities can be 
accomplished by loading the received transit times into a file 
in memory and reading them into the routine with subroutine 
DREAD. The hydrophone positions can also be read into a file 
to be referenced during operation. The initial covariance of 
estimation error P(l/0) , read in as a constant matrix, can be 
varied with the uncertainty of the targets initial positions 
and velocities. Any greatly erroneous time measurements caused 
by multipath signals or from noise spikes will cause the gains 
to zero, making the estimated position equal to the predicted, 
thus putting the filter in 'coast', and preventing catastrophic 
failure . 

The system was remodeled to include the X and Y velocities 
in the linearizing matrix H. This model is depicted in Figure 
38. With a constant Z, the targets position at time t^ is 
XqYq. By the time the transmitted signal has reached the hy- 
drophone array, the target with X velocity (V x ) and Y velocity 
(V^) has moved to the position at t 2 ; 
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where T is the transit time of the signal 
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X= X 0 + V X T 
Y= Y 0 + V y T 



FIGURE 38: Geometry used to remodel the System 
to include X and Y Velocities in the 
H Matrix 
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